clc
clear
load('middata.mat')
LLA1mid(1,:) = guider.lon*180/pi;
LLA2mid(1,:) = follower1.lon*180/pi;
LLA3mid(1,:) = follower2.lon*180/pi;
LLA1mid(2,:) = guider.lat*180/pi;
LLA2mid(2,:) = follower1.lat*180/pi;
LLA3mid(2,:) = follower2.lat*180/pi;
LLA1mid(3,:) = guider.altitude/1000;
LLA2mid(3,:) = follower1.altitude/1000;
LLA3mid(3,:) = follower2.altitude/1000;
save('LLA123mid.mat', 'LLA1mid');
save('LLA123mid.mat', 'LLA2mid', '-append');
save('LLA123mid.mat', 'LLA3mid', '-append');
V1mid = sqrt(guider.v_gx.^2 + guider.v_gy.^2 + guider.v_gz.^2);
V2mid = sqrt(follower1.v_gx.^2 + follower1.v_gy.^2 + follower1.v_gz.^2);
V3mid = sqrt(follower2.v_gx.^2 + follower2.v_gy.^2 + follower2.v_gz.^2);
save('LLA123mid.mat', 'V1mid', '-append');
save('LLA123mid.mat', 'V2mid', '-append');
save('LLA123mid.mat', 'V3mid', '-append');
fpa1mid = guider.fpa_local*180/pi;
fpa2mid = follower1.fpa_local*180/pi;
fpa3mid = follower2.fpa_local*180/pi;
azi1mid = guider.azi_local*180/pi;
azi2mid = follower1.azi_local*180/pi;
azi3mid = follower2.azi_local*180/pi;
save('LLA123mid.mat', 'fpa1mid', '-append', 'fpa2mid', '-append', 'fpa3mid', '-append');
save('LLA123mid.mat', 'azi1mid', '-append', 'azi2mid', '-append', 'azi3mid', '-append');